uint8   robot_id
uint8   cmd_mode
float32 yaw_angle
float32 pitch_angle
float32 yaw_rate
float32 pitch_rate